#include "Pathfinding.h"

Waypoint* findPath(float X, float Y, float XTarget, float YTarget) {
    //ToDo
    // Pseudopfadfindung, A* Algorythmus muss noch implementiert werden.

    Waypoint *wpT = (Waypoint*)malloc(sizeof(Waypoint));
    wpT->X = X;
    wpT->Y = Y;
    wpT->next = 0;

    Waypoint *wpN = (Waypoint*)malloc(sizeof(Waypoint));
    wpN->X = X;
    wpN->Y = YTarget;
    wpN->next = wpT;

    return wpN;
};
